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1  Introduction 

Manipulation  requires  contact  between  a  robot  and  an  object.  Although  contact  is  the 
fundamental  interaction  which  occurs  in  manipulation,  most  robotic  systems  rely  on  a  priori 
positional  information  in  order  to  perform  tasks.  Current  robot  systems  do  not  adequately 
sense  or  use  contact  information.  Instead,  they  rely  on  precise  pre-positioned  objects  and  arm 
joint  information  to  guide  the  robot  into  contact  with  these  objects.  When  contact  occurs,  as 
in  grasping  and  assembly  operations,  more  precise  and  intrinsically  mechanical  information  is 
required  than  can  be  obtained  from  vision  or  non-contact  sensing.  The  traditional  approach 
to  monitoring  and  controlling  such  interactions  falls  into  two  camps:  force  sensing  and 
tactile  sensing.  The  “classic-’  approach  to  force  sensing  employs  strain  sensitive  elements 
in  the  wrist,  drive  train  and  other  arm  structures  to  permit  measurement  and  control  of 
contact  and  assembly  forces  (see  Whitney  [1987]  for  an  overview).  This  method  focuses  on 
the  net  contact  force  and  does  not  address  contact  location  and  geometry.  On  the  other 
extreme,  tactile  sensors  have  been  used  to  sense  the  details  of  particular  contacts.  Such 
devices  employ  surface  mounted  arrays  of  force  sensitive  elements  which  can  be  used  to 
reveal  contact  locations,  shapes  and  contact  pressure  distributions.  See  Nicholls  and  Lee 
[1989]  for  an  extensive  survey  of  the  technology. 

An  alternative  approach  to  traditional  force  and  tactile  sensing,  developed  in  detail  here, 
relies  on  the  use  of  force  and  torque  measurements  to  reveal  a  contact's  location  and  force 
components.  One  of  the  simplest  embodiments  of  this  concept  is  shown  in  figure  1. 

By  measuring  the  moment  m  and  the  force  /  at  the  fixed  end  of  the  cantilever  beam, 
both  the  position  of  a  single  contact  and  the  magnitude  of  its  normal  component  of  force  can 
be  found  as:  p  =  /  and  c  =  m/f.  A  two-dimensional  version  of  this  idea  permits  contact 
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location  and  norma!  force  measurement  on  a  plane  by  simply  measuring  the  force  normal 
to  the  plane  and  two  moments  in  the  plane.  One  embodiment  of  this  idea  was  patented 
by  Peronneau  [1972].  It  turns  out  that  it  is  also  possible  to  sense  the  location  and  force 
components  of  contacts  occurring  on  a  non-planar  body,  under  appropriate  assumptions. 
Minsky  [1972]  mentions  this  idea  in  conjunction  with  a  force  sensing  wrist  on  a  robot. 

Salisbury  [1984]  and  Brock  and  Chiu  [1985]  described  a  structural  and  mathematical 
solution  appropriate  for  robot  fingertips  that  sense  the  location  of  point  contacts  which 
transmit  pure  forces,  along  with  the  components  of  the  contact  forces  themselves.  Their 
approach  has  been  reconsidered  bv  Tsuiimura  and  Yabuta  [1988],  Okada  Boon]  pr«^ntpr) 
a  suspension-cell  based  tactile  sensor,  very  close  in  spirit  to  this  sensing  concept.  Bicchi 
[1989,  1990a]  derived  a  complete  solution  which  takes  into  account  soft-finger  contact  effects. 
Eberman  and  Salisbury  [1989]  describe  how  joint  torque  measurements  in  a  robot  arm  may 
be  used  to  determine  the  location  of  a  contact  on  its  links.  The  broad  applicability  of  this 
concept  warrants  closer  examination  of  the  underlying  mathematics  and  has  thus  motivated 
this  paper. 

This  type  of  force-based  contact  sensing  is  inherently  different  from  more  traditional  tac¬ 
tile  sensing.  The  goal  of  most  tactile  sensing  systems  is  to  measure  the  pressure  distribution 
over  the  area  of  contact  in  order  to  infer  details  about  contact  location  and  shape.  However, 
the  goal  of  force- based  contact  sensing  is  to  measure  the  net  force  acting  on  a  body  and  to 
use  this  data  to  determine  the  properties  of  the  contact  through  which  the  force  is  exerted. 
Since  these  sensors  rely  on  measurements  taken  by  sensing  elements  which  are  placed  inside, 
rather  than  spread  over,  the  contacting  surface,  they  are  also  referred  to  as  intrinsic  tactile 
sensors. 

Although  the  theory  behind  such  sensors  is  relatively  complex,  ir.  practice  they  are  quite 
simple  to  build  and  utilize,  and  therefore  offer  enormous  potential  for  improving  robot  ma¬ 
nipulation  dexterity.  In  this  paper  we  present  the  theoretical  aspects  of  intrinsic  contact 
sensing  as  a  basis  for  device  design  and  application.  In  section  2,  we  survey  three  basic 
contact  models:  the  point  contact  without  friction,  point  contact  with  friction  and  soft  finger 
contact.  The  soft  finger  contact  type  is  particularly  important,  since  it  describes  the  most 
common  situation  encountered  in  manipulation.  In  section  3.  we  address  the  basic  math¬ 
ematics  and  mechanics  of  contact  sensing,  and  discuss  when  it  is  possible  for  a  sensor  to 
determine  the  location  and  the  resultant  force  and  moment  of  a  contact  given  internal  force 
and  moment  measurements.  Sections  4.  5,  and  6  describe  algorithms  to  solve  the  contact 
sensing  problem:  section  4  presents  a  general,  yet  approximate,  closed-form  algorithm,  sec¬ 
tion  5  describes  a  closed-form,  exact  solution  for  a  number  of  simple  sensor  surfaces,  and 
section  6  introduces  a  general  iterative  method.  Section  7  describes  some  possible  generaliza¬ 
tions  of  the  idea:  finally,  in  section  8  numerical  experiments  are  used  to  discuss  the  properties 
of  the  proposed  algorithms.  The  appendix  contains  proofs  of  the  propositions  introduced  in 
the  text. 
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2  Contact  Types 

The  concept  of  contact  type  is  basic  to  understanding  force-based  contact  sensing.  The 
contact  type  establishes  constraints  on  the  forces  which  may  be  applied  through  the  contact 
between  two  bodies  [Mason  and  Salisbury.  1985]. 

If  the  forces  which  act  upon  a  bod}'  sum  to  zero,  it  is  said  to  be  in  a  state  of  static 
equilibrium.  These  forces  may  arise  from  actuators,  body  forces  and  contacts  with  the 
environment.  Although  the  net  force  and  moment  on  a  system  in  static  equilibrium  will 
sum  to  zero,  there  will  be  non-zero  internal  forces  (i.e.  structural  stresses,  contact  forces 
etc.).  If  measurements  of  some  of  the  internal  forces  can  be  made,  they  can  be  checked  for 
consistency  with  the  expected  effects  of  a  particular  load  type,  and  hence  can  be  used  to 
deduce  information  about  the  contact(s). 

In  the  case  of  a  body  in  contact  with  another  when  arbitrary  forces  and  moments  can  be 
transmitted  through  the  contact  (i.e.  a  glued  contact  type),  not  much  may  be  said  about  the 
contact  geometry,  starting  from  force  measurements.  However,  other  common  contact  types 
impose  constraints  on  the  transmitted  forces:  their  components  usually  have  to  be  either 
unidirectional  or  limited  by  friction  cones.  It  is  these  constraints  which  make  the  whole 
concept  practical. 

A  point  contact  without  friction  constrains  the  force  applied  to  the  body  to  be  normal  to 
the  surface  at  the  point  of  contact,  and  the  moment  to  be  zero.  There  are  only  3  unknowns, 
the  2  contact  coordinates  on  the  surface  and  the  force  magnitude,  so  ideally  only  3  indepen¬ 
dent  force  measurements  would  be  required  to  reveal  the  contact  location  and  force.  If  we 
precisely  measure  all  3  force  components  acting  on  the  body,  the  associated  wrench  axis  is  a 
line  which  passes  through  the  point  of  contact  and  is  normal  to  the  surface  at  that  contact 
point  1 . 

A  point  contact  with  friction  also  constrains  the  force  applied  to  the  body  to  be  a  pure 
force,  but  it  is  no  longer  constrained  to  have  a  line  of  action  normal  to  the  surface  at  the 
point  of  contact  (it  must  however  lie  within  the  friction  cone  at  the  point  of  contact).  Since 
there  are  now  5  unknowns,  the  2  contact  coordinates  and  the  3  contact  force  components, 
ideally  only  5  independent  force  measurements  are  required  to  measure  the  contact  location 
and  force  components.  Again,  if  precise  measurements  are  available,  the  associated  wrench 
axis  is  a  line  which  passes  through  the  point  of  contact. 

Finally,  if  due  to  the  compliance  of  the  bodies,  finite  portions  of  the  surface  come  into 
contact,  and  if  friction  is  present,  torques  may  also  be  exerted  on  the  body.  In  this  situation, 
often  referred  to  as  soft  finger  contact ,  the  wrench  axis  no  longer  necessarily  passes  through 
the  contact  location.  As  will  be  shown  below  it  is  possible  to  define  and  solve  for  the  contact 
location,  and  force  and  moment  components  even  in  this  rather  general  case. 

‘The  wrench  axis  is  a  generalization  of  the  concept  of  line  of  action  of  forces  acting  on  a  body.  When  an 
arbitrary  set  of  forces  and  torques  acts  on  a  body,  they  may  be  canonically  described  by  a  unique  line  in 
space  along  which  a  unique  force  acts,  and  parallel  to  which  a  unique  moment  acts  (see  [Hunt,  1978]). 
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2.1  Soft  Finger  Contact  and  the  Contact  Centroid 

The  soft  finger  type  of  contact  is  the  most  general  case,  among  those  considered  above,  to 
which  intrinsic  contact  sensing  can  be  applied.  Point  contacts  with  or  without  friction  are 
particular  cases  of  soft  finger  contacts.  Indeed,  this  type  of  contact  is  also  the  most  common 
in  practical  manipulation:  for  instance,  contacts  through  which  humans  and  rubber  covered 
robot  hands  manipulate  objects  are  frequently  of  this  type. 

A  soft  finger  contact  occurs  between  two  real  (non-rigid,  possibly  inelastic)  bodies  mu¬ 
tually  transmitting  a  distribution  of  contact  tractions2  over  a  finite  area  of  contact.  The 
tractions  are  assumed  to  be  compressive,  that  is,  to  point  at  the  interior  part  of  the  body 
(adhesive  forces  between  bodies  are  therefore  disregarded  by  this  model).  Because  of  their 
distributed  nature,  a  complete  characterization  of  contact  related  phenomena  would  involve 
complex  continuum  mechanics  relationships,  whose  computation  (if  at  all  possible)  is  far  be¬ 
yond  the  capabilities  and  needs  of  a  real-time  robot  sensory  and  control  system.  A  compact 
characterization  of  contact  is  necessary  to  render  the  sensing  problem  tractable.  The  tra¬ 
ditional  approach  to  tactile  sensing  consists  of  spatially  sampling  the  traction  distribution, 
and  is  usually  limited  to  sensing  only  normal  force  components.  A  more  drastic  compression 
of  data  is  obtained  by  force-based  contact  sensing,  which  provides  a  reduced  set  of  contact 
features,  useful  for  manipulation  control.  This  is  achieved  by  the  use  of  an  equivalent  set  of 
forces.  Roughly  speaking,  two  sets  of  forces  are  equivalent  if  their  large-scale  effects  are  the 
same.  The  unknown  distribution  of  contact  tractions  can  be  substituted  with  an  equivalent 
set  of  forces,  comprised  only  of  a  resultant  force  (henceforth  designated  by  the  vector  p ).  and 
a  resultant  moment,  q.  Finally,  to  completely  describe  the  set  of  forces,  also  a  point  must  be 
provided,  through  which  the  resultant  force  effectively  is  applied.  The  choice  of  this  point 
is  not  trivial  in  the  soft  finger  case,  because  contact  occurs  over  a  whole  area.  We  show  in 
what  follows  that  a  very  convenient  point  to  use  for  representing  soft  finger  contacts  is  the 
contact  centroid,  which  we  define  as  follows: 

Definition  of  Contact  Centroid 

Given  a  surface  5  with  an  outward  normal  direction  defined  everywhere  on  it. 

and  a  distribution  A  of  compressive  tractions  applied  on  it.  a  contact  centroid  for 

5  and  A  is  a  point  on  5  such  that  a  set  of  forces  equivalent  to  A  exists,  having 

the  following  characteristics: 

i)  it  is  comprised  of  only  a  force  and  a  torque; 

ii)  the  force  p  is  applied  at  that  point,  and  is  directed  into  5; 

iii)  the  moment  q  is  parallel  to  the  surface  normal  at  that  point  (i.e.  a  pure 

torque  about  the  contact  normal). 

“The  term  traction  [Johnson,  1985)  indicates  a  force  per  surface  unit,  comprised  in  general  of  a  normal 
component  (pressure)  and  tangential  (friction)  components. 
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Figure  2:  The  contact  centroid  has  the  property  of  being  close  to  the  actual  contact  area. 

A  contact  centroid  per  se  has  some  very  useful  properties  that  render  it  a  desirable  point 
to  sense.  Firstly,  if  contact  occurs  at  a  single  point,  a  contact  centroid  coincides  with  that 
point.  Thus,  from  force/ torque  measurements  we  can  obtain  geometric  information  about 
where  the  contact  occurs,  a  typical  tactile  sensing  goal.  Useful  geometric  information  is 
still  contained  in  the  contact  centroid  even  when  multiple  points  and/or  finite  areas  are  in 
contact.  In  fact,  a  contact  centroid  has  an  important  property,  which  can  be  articulated  as 
follows: 

Proposition  1:  Property  of  Contact  Centroids 

Consider  a  deformable  body,  whose  undeformed  surface  5  is  convex,  and  assume 
that  a  distribution  A  of  compressive  contact  tractions  is  exerted  on  it.  Consider 
a  plane  P  that  divides  the  surface  of  the  body  in  two  portions,  confining  every 
contact  point  to  one  half-space  (see  figure  2).  Consider  the  projection  of  each 
contact  point  onto  P  along  the  direction  of  the  traction  applied  at  the  contact 
point  itself:  if  ail  such  projected  points  lie  within  the  volume  surrounded  by  the 
undeformed  surface  5'.  then  the  contact  centroid  3  lies  on  the  same  side  of  P 
where  A  is  applied. 

The  proof  of  this  property  takes  a  few  steps,  and  is  presented  in  Appendix  1.  The 
significance  of  this  property  is  related  to  the  fact  (to  be  proved  shortly)  that  it  is  possible 

3\\  e  will  show  in  section  3  that  for  convex  surfaces  the  contact  centroid  is  actually  unique 
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Figure  3:  A  spherical  sensor  surface  with  friction  coefficient  g  =  tan  p>. 


to  give  an  expression  of  the  contact  centroid  in  terms  of  force/torque  measurements  only. 
Accordingly,  although  an  intrinsic  contact  sensor  is  not  able  to  provide  an  image  of  the  actual 
contact  points,  if  some  hypothesis  on  curvature,  deformability  and  friction  of  the  surface  are 
satisfied,  we  have  at  least  an  idea  about  the  location  of  contact  points  over  the  sensor  surface, 
since  they  are  constrained  to  lie  "near"  the  contact  centroid4  (see  figure  2). 

As  a  corollary  to  the  property  above,  let  us  consider  a  generic  compressive  distribution  A. 
whose  tractions  comply  with  Coulomb’s  friction  law.  According  to  the  above  assumptions, 
it  is  required  that  the  intersections  with  P  of  every  friction  cone  lie  inside  the  volume 
surrounded  by  5.  Consider  for  instance  a  spherical  sensor  surface,  with  coefficient  of  friction 
g  =  tan<^>  and  small  deformability  (see  figure  3).  It  can  be  easily  shown  that  the  hypotheses 
of  the  above  property  apply  in  this  case  if  every  contact  point  can  be  seen  from  the  center 
of  the  sphere  within  an  angle  0  =  ir  —  2p>.  In  other  words,  if  the  contact  area  warped  around 
the  surface  is  "small"  enough  (and  this  bound  can  be  quantified),  then  the  contact  centroid 
is  a  valid  datum  about  contact.  For  a  cylindrical  or  spherical  sensor  wedged  in  a  corner  with 
angle  a,  and  friction  angle  the  condition  is  a  >  2  p>. 

4The  concept  of  contact  centroid  was  not  explicit  in  the  initial  definition  of  soft  finger  contact  given 
by  Salisbury  [1982],  that  was  based  on  an  assumption  of  very  small  contact  area.  The  contact  centroid 
introduced  by  Bicchi[1989]  allows  for  a  broader  applicability  of  the  soft  finger  contact  type.  It  should  be 
further  noted  that,  for  flat  surfaces,  the  contact  centroid  coincides  with  the  center  of  friction  introduced  by 
Mason  [Mason  and  Salisbury,  1985]. 
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Figure  4:  Vector  quantities  and  notation  involved  in  the  problem  statement. 

3  Problem  Formulation 

One  possible  implementation  of  an  intrinsic  contact  sensor  consists  of  a  surface,  which  we 
will  call  a  fingertip,  supported  by  a  six-axis  force/torque  sensor.  The  force/torque  sensor 
measures  all  three  components  of  both  the  resultant  force  f  and  the  resultant  moment  m 
with  respect  to  the  reference  frame  B.  as  shown  in  figure  4.  Note  that  the  choice  of  the 
reference  frame  B  is  arbitrary,  since  we  can  easily  express  f  and  m  in  terms  of  any  other 
coordinate  frame  fixed  to  B. 

The  fingertip  surface  can  be  described  by  the  implicit  relation 

5(r)  =  0,  (1) 

where  r  is  a  point  in  space  defined  with  respect  to  B .  The  surface  5  should  hav^  continuous 
first  derivatives,  so  that  a  normal  unit  vector  can  be  defined  at  every  point  on  S  as 

V5(r) 

n  l|VS(r)|f 

where  V  indicates  the  gradient  operator.  Let  c  be  the  contact  centroid,  and  p.  q  the  force 
and  moment  applied  at  c.  which  are  equivalent  to  a  “soft  finger"  contact.  The  measurable 
quantities  f  and  m  are  related  to  the  unknowns  c.  p  and  q,  by  force  and  moment  balance 
equations. 

f  =  p.  (21 

m  =  q  +  c  x  p.  (3) 
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For  soft  finger  contacts  the  torque  q  is  parallel  to  the  unit  vector  n  normal  to  the  surface  at 
the  contact  centroid  c.  hence 

n  x  q  =  —  V5(c).  ill 

for  some  constant  A. 

We  call  the  above  set  of  relations  the  contact  sentnui  problem-. 

Given  the  measurements  f  and  m.  along  with  a  surface  equation  >'(•)  =  0.  de¬ 
termine  the  location  of  the  contact  centroid(s)  c.  and  the  related  contact  force  p 
and  moment! s)  q. 

Note  that,  because  of  the  definition  of  contact  centroid,  we  implicitly  require  that  p  is 
compressive,  i.e.  directed  into  the  surface,  and  that  q  is  normal  to  5.  Expanding  equations  1 
through  4  yields  a  non-linear  system  of  ten  equations  in  ten  scalar  unknowns,  i.e.  the  nine 
components  of  p.  q,  c.  and  A  .  However,  by  simply  substituting  equations  2  and  4  i rf 
equation  3.  the  problem  is  reduced  to  four  equations  in  four  unknowns.  Since  the  problem 
is  non-linear,  we  need  to  determine  if  a  solution  exists,  and  in  that  case  if  it  is  unique. 

In  general,  not  much  can  be  said  about  the  existence  of  solutions:  given  arbitrary  f.  m. 
and  5.  there  is  no  guarantee  we  can  find  an  equivalent  soft  finger  contact.  A  solution  exists, 
however,  if  the  resultant  force  f  and  and  moment  m  are  measurements  consistent  with  the 
effects  of  a  soft-finger  type  traction  distribution  on  5. 

[fa  solution  exists,  the  following  proposition  holds  about  its  uniqueness: 

Proposition  2:  Uniqueness  of  Solutions 

solution  to  the  contact  sensing  problem  is  unique  (if  it  exists),  if  and  only  if 
the  sensor  surface  is  convex  (see  proof  in  Appendix  2). 

Proposition  I  gives  conditions  on  A  and  A  that  guarantee  the  existence  of  a  contact, 
centroid.  According  to  proposition  2,  th«.  contact  centroid  of  a  compressive  distribution  A 
on  a  convex  surface  is  also  unique. 

As  a  final  remark,  the  solution  to  equations  l  through  4  may  not  be  trivial  and  a  closed- 
form  solution  may  not  be  found  except  for  the  simplest  surfaces.  In  the  following  sections, 
we  will  present  three  methods  for  solving  these  equations:  first  the  simple  point  contact 
solution  ,  next  the  ellipsoidal  solution  and  finally  a  general  iterative  solution. 

4  Point-contact  solution 

The  first  closed-form  method  we  present  for  solving  the  contact  sensing  problem  utilizes 
more  restrictive  assumptions  than  those  specified  in  the  following  sections.  In  particular,  we 
assume  the  local  torque  q  about  the  contact  normal  is  zero.  In  other  words  we  assume  the 
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..onfact  model  is  a  point  contact  with  friction,  as  described  in  section  2.  This  assumption 
can  lead  to  good  results  and  a  simple  solution  for  a  large  number  ol  practical  cases.  The 
wrench  axis  of  the  force  system  is  given  by 


f  x  m 


The  wrench  axis  is  a  line  through  r0  and  parallel  to  f.  parameterized  by  ,\.  This  line 
intersects  the  convex  surface  5  in  at  most  two  locations:  one  corresponding  to  a  force  pulling 
out  of  the  surface  and  one  corresponding  to  a  force  pushing  into  the  surface.  Since  we  do 
not  allow  adhesive  forces,  we  can  determine  the  contact  centroid  as  the  intersection  point, 
for  which  the  contact  force  is  directed  into  the  surface,  that  is 

f rn(,c)  <0.  ( T) 

When  the  local  torque  q  is  not  zero,  the  point  found  by  this  method  differs  from  the 
contact  centroid.  Therefore  we  will  denote  with  c'  the  vector  found  using  this  (so-called 
"wrench-axis"  or  "point-contact")  method. 

Note  that  the  assumption  q  =  0  can  be  checked  out  directly  from  force/torque  measure¬ 
ments  by  means  of  the  equivalent  relationship  frm  =  0.  We  should  point  out  that  the  point 
c'  does  not  have  any  of  the  properties  of  contact  centroids,  so  that  it  could  in  principle  lie  tar 
away  from  the  actual  location  of  the  contact  area.  Yet.  point  c'  retains  a  valuable  meaning 
in  real  conditions  as  an  easy-to-compute  approximation  of  the  contact  centroid.  In  order 
to  give  an  estimate  of  the  distance  between  c'  and  the  contact  centroid  c.  let  e  represent 
the  difference  vector  e  =  c'  —  c.  The  two  sets  of  forces  and  torques,  p.  q  applied  at  c.  and 
p.  t  applied  at  c'.  are  both  equivalent  with  the  actual  set  of  contact  forces,  hence  they  are 
equivalent  with  each  other.  The  balance  equation  of  moments  about  c  can  be  written  as 


q  =  t  +  e  x  p. 

Such  a  vector  equation  is  solved  by  any  e  of  the  form 

(q  -  t)  x  p 


e  = 


ill  2 


up. 


t>) 


Recalling  that,  from  the  definition  of  wrench  axis,  t  is  parallel  to  p.  ami  that,  by  the 
lefinifion  of  contact  centroid,  q  is  normal  to  the  surface,  we  ran  rewrite  equation  S  as 


e  = 


q  *  Pi 


4-  u  p. 
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where  pf  =  p  —  (prn)n  is  the  tangential  (friction)  component  of  the  contact  resultant  force. 
Since  the  error  vector  e  is  the  sum  of  two  mutually  orthogonal  vectors,  its  length  is  at  least 
as  large  as: 

„  ^  llqil  1,'Pfll 

I! eij  >  - . 

!!P:i‘ 

In  view  of  this  remit,  it  can  be  observed  that,  when  the  local  torque  q  is  not  zero,  the 
distance  between  the  point  found  by  the  wrench-axis  method  and  the  contact  centroid  grows 
quickly  as  friction  increases.  Thus,  the  approximation  of  the  contact  centroid  with  point  c' 
should  be  avoided  if  high-friction  and/or  compliant  materials  are  employed  in  building  the 
fingertips.  Numerical  examples  are  provided  in  the  discussion  section. 


5  Solution  for  Ellipsoidal  Surfaces 

The  main  advantage  of  the  wrench-axis  method  is  that  the  contact  location  problem  is 
reduced  to  that  of  finding  the  intersections  of  a  line  with  a  surface,  that  is.  to  elemen¬ 
tary  geometry.  However,  this  method  has  two  major  drawbacks:  first,  it  does  not  provide 
information  about  the  moment  exerted  through  a  soft-finger  contact,  and  second,  it  only 
approximates  the  contact  centroid  when  q  is  not  zero.  In  this  section  we  solve  the  contact 
sensing  problem  and  avoid  such  shortcomings.  However,  in  order  to  guarantee  a  closed- form 
algorithm  and  to  simplify  calculations,  the  fingertip  surface  will  be  restricted  to  belong  to  a 
specific  class  of  surfaces,  namely,  quadratic  forms  of  the  type 

5(r)  =  rrArAr  -  R2  =  0.  (9) 

where  A  is  a  constant  coefficient  matrix,  and  R  is  a  scale  factor  used  for  convenience.  Since 
the  reference  frame  B  ran  be  moved  arbitrarily,  we  can  assume  without  loss  of  generality 
that  A  can  be  written  in  diagonal  form 

/  1/q  0  0  \ 

A  =  0  1/13  0 

\0  01/7/ 

In  order  to  guarantee  the  uniqueness  of  solutions,  the  surface  specification  must  be  further 
restricted  to  convex  portions  of  the  quadratic  form  (for  instance,  one  of  the  sheets  of  a 
double  hyperboloid  would  be  an  appropriate  sensor  surface).  In  the  interest  of  simplicity, 
however,  we  will  consider  in  the  following  only  general  ellipsoids  (i.e..  positive  definite  A 
matrices).  In  this  case,  the  principal  axes  of  the  ellipsoid  are  given  by  2a/?.  2 JR  and  2 '  R. 
with  0  <  1/a  <  l.  0  <  l/J  <  1,  0  <  I/7  <  I. 

It  should  be  noted  that  ellipsoids  are  important  for  several  reasons.  First,  ellipsoids  ap¬ 
proximate,  up  to  the  second  order,  any  continuous  convex  surface.  Second,  very  common 
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surfaces,  such  as  spheres,  cylinders,  and  planes,  can  be  regarded  as  limiting  cases  of  an  ellip¬ 
soid.  Finally,  the  ellipsoid  assumption  is  standard  in  contact  mechanics  (e.g.  the  Hertzian 
theory  of  elastic  contact). 

Substituting  equation  9  into  equation  4  yields 

A2c 

n  =  _J -  x  q  =  KA2c.  i  10  i 

il'A-cil 

and  substituting  this  and  equation  2  in  equation  3,  we  obtain 

m  =  A' A2r  +  r  x  f .  (11) 

Equations  9  and  11  form  a  system  of  four  non-linear  equations  and  four  unknowns  which 
can  be  rewritten  in  the  form 


Tc  =  m 
crA2c  =  R2. 


(12) 

(13) 


where  T  =  T(I\)  is  a  3  x  3  matrix  whose  elements  are  functions  of  I\  and  of  the  measured 
force  components  /t,  /2  and  /3, 

-h  \ 

fi 

K/1 2  1 

The  determinant  of  T(K)  is  given  by 

det  r(/0  =  K{K2D2  +  |(Af(|2), 


r(A')  = 


where  D  =  det  A.  The  matrix  T(A')  is  singular  for  K  =  0,  i.e.  when  the  local  torque  q 
is  zero.  In  this  case  (which  can  be  detected  by  the  simple  equivalent  condition  frm  =  0. 
as  already  mentioned),  the  contact  centroid  can  be  determined  exactly  by  the  wrench-axis 
method.  The  value  of  the  parameter  A  in  equation  5  corresponding  to  the  intersection  of  the 
wrench-axis  with  the  ellipsoid  surface  is  given  by 

,  -f'Tri  -  v/(f'Ti4)»-||f'||>(l|i4l|J-RJ) 

Ilf'IP 

where  f'  =  Af  and  r'0  =  Ar0  (recall  the  definition  of  i*o  in  equation  6). 

Whenever  frm  ^  0,  T(A')  has  an  inverse  T  1  ( A" )  such  that,  by  solvng  equation  12  for 
c,  we  obtain 
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c  =  T  ’m  =  —  l--[K2D2A  2m  +  A'(A2f)  x  m  +  (fTm)fl. 
det  r 

By  substituting  equation  14  into  equation  13.  a  scalar  equation  in  the  only  unknown.  A’,  is 
obtained  as 


ctA2c  =  R2  = 

A'4£>4||A-1m||2  +  A'2||A(  A2f  x  m)||2  +  (fTm)2(|| Af||2  4-  2K2D2) 

K2{K2D2  4-  ||Af ||2)2  '  ( 

For  such  a  6-th  order  equation  a  closed-form  solution  should  not  be  expected  in  general, 
due  to  Galois’  theorem.  For  the  particular  surface  assumed,  though,  we  observe  that 

II A( A2f  x  m)||2  =  D2  [|| A-1m||2|| Af ||2  -  (frm)2]  . 

so  that  equation  15  can  be  simplified  in  a  biquadratic  equation  as 

I\*D2R2  +  A'2  [H2 H Af ||2  -  D2||A-1m||2]  -  (fTm)2  =  0. 

Only  one  of  the  four  possible  I\  solving  this  equation  is  real  and  consistent  with  the 
hypothesis  of  non-adhesive  contact,  and  is  given  by 

K  =  \A  +  P  +  ^^>2A2(fTm)2.  (16) 

where 

<7  =  Z)2||  A_1m|j2  —  A2||Af||2, 

and 

(  —1,  for  x  <  0 
sign(x)  =  <  0.  for  x  =  0 

(  1,  for  x  >  0 

By  substituting  I\  back  into  equation  14  and  equation  10.  we  obtain  the  complete  solution 
for  c  and  q,  respectively. 

5.1  Particular  Cases 

We  will  now  develop  solutions  for  some  particular  cases  of  practical  importance,  namely  the 
sphere,  cylinder  and  plane. 
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5.1.1  Sphere 

For  a  spherical  sensor  surface  of  radius  R  centered  at  the  origin  of  the  force/ torque  reference 
frame  B.  the  matrix  A  equals  the  identity  I3,  and  D  =  1.  Hence. 


A  = 


— sign)  frm) 

ZJr 


n'  4-  yV2  +  4/?-(  f  rm  i-. 


where  a'  =  |jm||2  —  /?2||f||2. 

The  contact  centroid  location  (for  nonzero  A')  is  given  by 


c  = 


1 


[A'2m  +  A'f  x  m  +  (frm)f], 


A'(A'2  +  ||f||2) 

whereas,  for  K  =  0.  the  contact  centroid  is  found  using  equation  5  with 


A  =  - 


1 


R2  - 


Iff  x  m||2 


5.1.2  Cylinder 

Consider  a  cylinder  having  the  axis  parallel  to  the  2  axis  of  the  sensor  frame  B ,  and  circular 
cross  section  of  radius  R.  Such  surface  can  be  described  as  the  limit  case  of  an  ellipsoid  with 
characteristic  matrix  given  by 


10  0  \ 
0  10 
00  1/7  / 


for  7  — *•  oo.  Applying  the  same  limit  to  equation  16,  we  have: 

-fTm 


I<  = 


nv 


"112 


where  fx  =  (/i,/2,0)r  is  the  component  of  f  normal  to  the  cylinder  axis,  and  m"  = 
(0.0,  m3)T  is  the  component  of  m  parallel  to  the  same  axis.  If  A'  =  0.  the  wrench  method 
(equation  5)  should  be  applied.  Otherwise,  the  contact  centroid  on  the  cylindrical  surface  of 
the  fingertip  is  given  by: 

c  =  -jrp - p  [A'2m"  +  A'f1  x  m  +  (frm)f]. 
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5.1.3  Plane 

An  ellipsoid  with  matrix  A  of  the  form 


/  1/7  0  0  \ 

A  =  0  1/7  0 

V  0  oi/ 

degenerates,  for  7  — ►  00.  in  a  couple  of  parallel  planes  perpendicular  to  the  x  axis  of  B.  at  a 
distance  ±R  from  the  origin.  If  f"  =  (0.0,  /3)7  is  the  contact  force  component  parallel  the 
z  axis,  equations  16  and  1-4  become 


K  = 


-frm 

WT\ 


and 


c  = 


(f"  X  m+R  ||f"||  f). 


It  should  be  noted  that  the  last  formula  holds  even  with  I\  =  0. 


6  Iterative  solution 

The  final  method  for  solving  the  contact  sensing  problem  is  valid  for  any  surface  specifi¬ 
cation,  but  requires  an  iterative  algorithm  to  be  used  at  each  sensor  sampling  time.  The 
computational  efficiency  of  the  algorithm  is  therefore  of  utmost  importance  for  real-time 
applications. 

As  customary  when  dealing  with  the  numerical  solution  of  vector  multivariate  functions, 
we  rewrite  the  problem  equations  in  the  relaxation-method  form 


where: 


g(x)  =  0, 


XT 

—  ( ,  x2 , 

=  (CT, 

K/2) 

gT(x) 

=  ($l(x). 

^(x),53(x),p4( 

x))T. 

<7i(x) 

=  I4VS1 

—  /2J3  +  /3^2  “ 

-  mj; 

02(x) 

=  x4V52 

—  /3-1'  l  +  /lx3  “ 

-  m2; 

<73(x) 

=  X4VS3 

—  f\ 2 2  +  /2-Tl  “ 

-  my. 

04(x) 

=  S{x  i,x2,x3). 

(17) 
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Standard  algorithms  (see  e.g.  [Dahlquist  and  Bjork.  1974])  for  the  iterative  solution  of 
such  equations  can  be  applied,  perhaps  the  most  notable  being  the  Xewton-Raphson  method 
or  its  variations.  The  Jacobian  matrix  G  associated  with  the  problem  can  be  evaluated  as 


dg  1 

(  x4H  -  f-> 

V5 

dx  \ 

v 

0 

where  H  is  the  Hessian  of  the  surface  5  (that  is.  the  matrix  HtJ  =  i-j  =  1.2.3:).  and 

fs  is  the  cross-product  matrix  of  f.  such  that  figc  =  f  x  c. 

Computing  G  can  be  more  or  less  time  consuming,  depending  upon  the  complexity  of  the 
surface  5.  Computing  G_1,  as  required  by  the  Newton- Raphson  method,  can  be  inconvenient 
for  real  time  applications.  Furthermore,  in  this  specific  case,  we  have  that  G  is  singular  for 
x4  =  K/2  =  0.  that  means  that  this  algorithm  would  present  serious  problems  whenever  the 
contact  load  has  very  little  local  torque  q. 

It  must  be  noted  that,  in  general,  the  numerical  solution  of  vector  multivariate  nonlinear 
equations  is  not  a  "nice"  problem  (see  the  related  comments  in  [Press  et  al..  19SS]):  better 
algorithms  are  available  for  finding  the  extrema  of  multivariate  scalar  functions.  A  possible 
approach  to  the  design  of  an  algorithm  for  solving  equation  17  is  therefore  to  embed  the 
root-finding  problem  in  a  minimization  one. 

Since  the  Jacobian  matrix  G  is  not  symmetric  (its  upper  left  minor  is  the  sum  of  a 
symmetric  and  a  skew-symmetric  matrix),  g  cannot  be  simply  regarded  as  the  gradient  of 
some  energy-like  function  to  minimize.  However,  if  we  consider  the  equation 

Grg(x)  =  0, 

we  have  that  all  the  zeroes  of  g  are  also  zeroes  of  Grg,  and  Grg  is  the  gradient  (“poten¬ 
tial  field")  associated  with  the  positive  definite  scalar  function  V  =  |grg,  whose  absolute 
minimum  is  our  solution. 

Applying  the  well-known  gradient  descent  updating  law  to  the  k-th  estimate  of  x.  we 
have 

x<*+D  =  *(*)  -  ^VV(x)  =  x(fc)  -  AGjjgjk). 

We  observe  that  the  application  of  this  gradient  descent  technique  to  minimize  an  energy¬ 
like  (Liapunov)  function  V  =  dT(q)<£(q)  is  equivalent  to  the  closed-loop  inverse  kinematic 
scheme  proposed  by  Balestrino.  DeMaria  and  Sciavicco  [1984]  and  several  others,  to  invert 
the  nonlinear  kinematic  relationship  of  a  robot,  d>( q) .  It  can  be  shown  with  a  Liapunov 
argument  that  this  method  is  locally  asymptotically  convergent  to  the  desired  solution,  for 
appropriate  choices  of  A:  and.  in  fact,  it  is  intuitive  that  for  A  (i.e.  step  lengths)  short 
enough  in  the  steepest  descent  direction  the  V  function  will  be  always  kept  decreasing  until 
a  minimum  is  reached.  A  discussion  on  the  optimal  choice  of  A  has  been  provided  by  Das. 
Slotine  and  Sheridan  [1989]. 
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Figure  5:  The  fingertip  sensors  of  the  Salisbury  Robot  Hand  are  composed  of  a  hemisphere 
joined  to  a  cylinder. 


The  local  asymptotic  convergence  of  the  algorithm  means,  in  our  current  application,  that 
the  correct  contact  point  will  be  found  provided  that  the  initial  guess  is  "close  enough".  In 
order  to  avoid  that  for  arbitrary  initial  guesses  and  for  some  force/torque  readings  f.  m,  the 
algorithm  gets  "stuck”  at  some  point  that  does  not  solve  the  problem,  it  would  be  desirable 
to  assess  a  more  general  global  asymptotic  convergence.  Unfortunately,  the  technique  of 
embedding  the  root-finding  problem  in  a  minimization  one  is  prone  to  generate  such  local 
minima,  and  some  do  exist  in  our  specific  problem  even  for  surfaces  as  simple  as  spheres. 
From  a  practical  point  of  view  those  "false”  roots  are  easily  recognized  (their  residues  grg 
are  not  zero).  Moreover,  if  the  algorithm  is  used  to  continuously  track  a  contact  which 
changes  its  position  and  force  components  with  continuity  (i.e.  it  is  rolling  or  sliding  across 
the  sensor),  starting  the  search  from  the  previously  obtained  solution  is  very  likely  to  lead 
to  the  actual  solution. 


7  Compound  surfaces 

Many  applications  of  intrinsic  contact  sensing  use  surfaces  more  complex  than  the  simple 
geometries  described  above.  However,  the  methods  presented  above  can  be  extended  easily 
to  compound  surfaces  made  of  simpler  surfaces  if  the  compound  surface  is  convex  and  the 
component  surfaces  share  the  same  normal  at  their  boundaries.  For  example,  the  fingertip 
sensors  of  the  Salisbury  Robot  Hand  are  composed  of  a  hemisphere  joined  to  a  cylinder 
of  equal  radius,  as  depicted  in  figure  5.  A  solution  for  a  compound  surface  is  typically 
found  by  trial  and  error:  the  contact  centroids  corresponding  to  the  given  load  and  to  the 
complete  ellipsoids  to  which  the  basic  patches  of  the  compound  surface  belong,  are  calculated 
in  succession:  by  virtue  of  the  uniqueness  property  of  contact  centroids,  the  search  can  be 
stopped  as  soon  as  a  contact  centroid  lying  on  the  actual  sensor  surface  is  found. 

If  the  sensor  surface  has  sharp  points,  as  the  example  depicted  in  figure  6.  a  normal 
direction  cannot  be  defined  at  those  points  and  the  above  discussed  solution  methods  are 
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not  applicable  directly.  If  the  sensor  or  the  object  surfaces  are  compliant,  this  problem  is 
not  a  major  concern,  since  surface  edges  are  "smoothed"  out.  and  the  properties  of  the 
contact  centroid  guarantee  that  a  meaningful  result  will  be  achieved  anyway.  However,  if 
a  rigid  contact  occurs  on  a  sharp  point  of  the  sensor  surface,  no  local  torque  is  exerted: 
therefore,  any  point  found  by  intersecting  the  wrench  axis  with  the  different  surface  patches 
should  coincide  with  the  actual  contact  point.  Since,  in  general,  only  noisy  measurements  are 
available,  it  may  happen  that  no  contact  centroid  actually  lying  on  the  sensor  surface  is  found. 
In  this  case,  a  good  approximation  can  be  assumed  to  be  the  point  on  the  sensor  surface 
closest  to  the  calculated  centroids.  The  worst  case  is  when  a  whole  edge  of  the  sensor  surface 
is  in  contact  with  the  object.  Since  local  torques  can  be  exerted,  and  no  normal  direction  is 
defined,  both  methods  discussed  above  would  fail.  However,  the  practical  relevance  of  such 
cases  is  negligible. 

More  complex  surfaces  that  do  not  comply  writh  the  above  assumptions  of  convexity  and 
regularity  can  be  dealt  with  in  some  cases.  For  example,  a  typical  manipulator  arm  is  com¬ 
posed  of  individually  convex  surfaces,  but  is  not  convex  as  a  whole  (see  figure  7).  Eberman 
and  Salisbury  [19S9]  discussed  the  use  of  joint  torque  measurements  to  infer  information 
about  contacts  occurring  on  the  last  link  of  the  robot.  On  the  other  hand,  a  force/torque 
sensor  at  the  base  of  the  manipulator  would  sense  contacts  on  any  link,  but  would  not  be 
able  to  distinguish  among  them.  By  the  use  of  both  base  force/torque  sensing  and  joint 
torque  sensing  it  is  conceivable  to  realize  a  fully  sensorized  robot  surface.  A  “whole  hand" 
manipulation  system,  employing  intrinsic  contact  sensors  in  each  phalanx  of  its  three  fingers 
and  in  the  palm,  has  been  designed,  and  a  prototype  finger  built,  as  reported  by  Yassura 
and  Bicchi  [1989]. 
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Joint  Torque 


Figure  7:  Fullv-sensorized  robot  arm  can  be  constructed  in  principle  using  only  force/ torque 
measurements. 


8  Discussion  and  Numerical  Results 

In  this  paper  we  presented  material  on  the  mathematics  and  mechanics  of  intrinsic  contact 
sensing.  The  paper’s  main  contributions  are  perhaps  the  introduction  of  the  concept  of 
contact  centroid  along  with  the  proof  of  its  geometric  properties,  and  the  presentation  of 
mathematical  methods  for  computing  its  location  on  a  sensor  surface.  In  this  section  we  will 
briefly  elaborate  on  these  themes,  to  underscore  some  interesting  aspects. 

The  interest  of  the  contact  centroid  for  characterizing  soft  fingers  contacts  follows  from  its 
property  of  being  located  inside  the  convex  hull  enclosing  every  contact  point.  To  illustrate 
this,  a  simple  numerical  example  will  be  worked  out.  Assume  that  the  real  pattern  of  contact 
on  the  surface  of  a  spherical  sensor  is  comprised  of  only  four  points  C|, . . . ,  c4,  located  on  top 
of  the  sphere  as  shown  in  figure  8,  and  let  ±6  and  ±8<5  be  the  coordinates  along  the  x-axis 
of  points  Ci,  C3,  C2,  and  c4  respectively. 

Let  the  local  contact  forces  exerted  at  these  points  be  hi  =  (  —  h/.h/.—l). 

h3  =  (  —  h3  =  {hf,  hf,  —  1),  and  h4  =  (hf,  hf,  —  1),  respectively.  Table  1  gives 

the  x-coordinates  of  the  contact  centroid  c  (calculated  through  the  algorithm  proposed  in 
section  o)  and  of  the  point-contact  method  point  c'  (section  4)  corresponding  to  different 
values  of  8  and  hf. 

As  can  be  seen,  the  two  results  diverge  as  the  distance  6  and  the  friction  force  h j  increase. 
Note  also  that  for  large  values  of  6  the  contact  centroid  retains  the  characteristic  of  remaining 


10 


■ 

0.125 

0.25 

0.5 

0.1 

cx  :  0.000 

cx  :  0.000 

cx  :0.000 

IM. 

0.7 

cx  :  0.000 

cx  :0.005 

cx  :0.039 

[WtifT.El 

c'x  :0.65S 

1 

cx  :  0.001 

cx  :0.010 

cx  :0.077 

IWiJWilil 

■B1DHM 

Table  1:  Position  of  the  contact  centroid  c  and  of  the  approximated  (wrench-axis  method) 
point  c'  along  the  x-axis  for  different  values  of  S  and  kf. 
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Wrench- Axis 
Method 

Ellipsoid 

Method 

Iterative 

Method 

Execution  time 

232±6  /isec 

486±13  /isec 

473±13  /< sec/'step 

Table  2:  Computation  times  for  the  three  algorithms  to  solve  the  contact  problem  on  a 
sphere.  The  iterative  method  takes  an  average  of  20  steps  to  converge  under  to  an  error  of 
less  than  one  part  in  106  error  when  input  data  are  slowly  varying. 

inside  the  contact  points,  while  the  point  obtained  by  the  point-contact  method  does  not. 

Another  important  advantage  of  the  intrinsic  contact  sensing  method  is  its  ability  to 
calculate  the  local  torque  originated  from  friction  forces.  The  importance  of  these  local 
torques  in  fine  manipulation  operations  by  robot  hands  has  been  often  underestimated.  To 
appreciate  their  role,  consider  how  humans  can  hold  a  stick  horizontally  by  pinching  it  at 
one  end  between  two  fingertips  (with  a  gripping  force  of  ION,  the  fingers  can  typically  resist 
a  torque  of  40Nmm  and  a  vertical  weight  of  5N). 

The  computational  efficiency  of  the  solution  algorithms  is  of  paramount  importance  in 
real-time  applications  of  intrinsic  contact  sensing.  In  table  2  we  report  computation  times 
for  the  same  surface,  a  sphere  centered  in  the  origin.  The  algorithms  described  in  sectiond. 
5  and  6  have  been  implemented  and  timed  in  a  real-time  environment  running  on  a  Mo¬ 
torola  68030  processor  with  a  Motorola  68881  numeric  coprocessor.  Note  that  the  iterative 
algorithm  is  inferior  to  the  other  solutions,  which  are  both  fast  enough  to  be  claimed  real¬ 
time.  Another  weakness  of  the  iterative  method  is  that  the  multiple  solutions  of  equation  17 
cannot  be  discriminated  in  advance  of  their  actual  computation.  The  iterative  algorithm 
is  then  recommended  only  for  finding  a  complete  solution  for  non-ellipsoidal  surfaces  (e.g. 
paraboloids)  for  which  closed-form  exact  methods  are  not  available. 

To  conclude  the  comparative  analysis  of  the  proposed  algorithms,  it  must  be  noted  that 
the  exact  method  of  section  5  is  also  preferable  to  the  wrench-axis  algorithm  from  a  numerical 
stability  point  of  view.  In  fact,  as  the  formulation  of  the  problem  in  terms  of  minimization 
of  a  quadratic  error  function  given  in  section  6  shows,  the  contact  problem  is  intrinsically 
stable.  This  is  not  true  of  the  approximation  that  disregards  local  torques.  Table  3  shows 
how  small  perturbations  on  the  inputs  (the  force/torque  sensor  readings  f  and  m)  reflect  in 
small  perturbation  in  the  calculated  contact  point  for  the  method  of  section  5,  while  they 
can  lead  to  inconsistent  (complex)  results  for  the  wrench-axis  method. 

Devices  based  on  the  force-based  contact  sensing  approach  have  been  actually  imple¬ 
mented.  and  effectively  employed  in  robotic  hands.  For  a  discussion  on  the  realization 
of  force/torque  sensors  on  small  robot  fingertips,  see  [Brock  and  Chiu.  19S5],  and  [Bicchi 
1987].  The  latter  paper  discusses  the  application  of  optimal  design  techniques  to  minia¬ 
turized  force/torque  sensors;  this  approach  is  expanded  in  a  more  thorough  treatment  in 
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Method 

F/T  Measurements 


Wrench- Axis 


Ellipsoid 


Iterati  vp 


A,  . . .  — I 


■ - - - - 

c'  =  [-0.60  0.80  0.00] 

c  =  [-0.60  0.80  0.00] 

c  =  [-0.60  0.80  0.00] 

f  =  ]-0.3  -.04  0.01] 
m  =  [0.01  0.01  0.49] 

c'  =  [-0.06  0.75  0.00] 

HBBiSjIBaiiMaii 

c'  =  [?  ?  ?] 

c  =  [-0.74  0.67  0.09] 

c  =  [-0.73  0.68  0.07] 

f  =  [-0.3  -.04  0.01] 
m  =  [0.01  0.01  0.51] 

c'  =  [?  ?  ?] 

c  =  [-0.76  0.62  0.20] 

c  =  [-0.76  0.62  0.20] 

Table  3:  Algorithm  sensitivity  example.  Noise  on  the  measurement  of  the  second  component 
of  the  measured  moment  m  is  simulated.  The  centroid  is  computed  for  a  unit  radius  sphere. 
Question  marks  indicate  inconsistent  (complex)  results. 


[Bicchi,  1990b]. 

The  applications  of  intrinsic  contact  sensors  to  robotic  manipulation  are  numerous,  and 
several  have  been  experimentally  verified.  Although  it  is  not  possible  to  detail  these  appli¬ 
cations  here,  they  will  be  cited  for  reference: 


•  The  exploration  of  unknown  objects  by  probing  with  an  intrinsic  tactile  sensor,  and 
the  reconstruction  of  their  surface  profile  has  been  described  by  Brock  and  Chiu  [1985], 
and  later  by  Tsujimura  and  Yabuta  [1988].  Both  authors  employed  the  point-contact 
method  algorithm.  Bicchi  [1989]  reported  explorations  performed  using  the  more  pre¬ 
cise  algorithm  of  section  5,  and  an  hybrid  control  scheme,  which  allowed  continuous 
control  of  the  normal  component  of  contact  force. 


•  The  capability  of  intrinsic  contact  sensors  to  evaluate  the  friction  components  of  the 
contact  force  and  the  local  torque  (which  is  unique  among  other  available  sensing 
devices),  has  been  used  to  measure  the  coefficients  of  friction  of  various  objects  [Bicchi. 
1989].  This  information  in  turn  has  been  used  to  discriminate  between  objects  on  the 
basis  of  their  apparent  friction,  and  to  plan  subsequent  slippage-safe  operations  of  the 
hand. 


•  A  real-time  control  method  for  augmenting  the  stability  of  the  grasp  of  unmodeled  ob¬ 
jects  against  slippage  has  been  discussed  and  demonstrated  (in  a  rather  simple  setting) 
by  Bicchi.  Salisbury  and  Dario  [19S9]. 


The  exploitation  of  contact  sensory  information  is  expected  to  allow  improvements  in 
many  areas  of  fine  manipulation  control.  Contact  sensors  such  as  those  described  in  this 
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paper  can  provide  direct,  real-time  and  reliable  feedback  of  fundamental  contact  interaction 
characteristics.  For  instance,  intrinsic  contact  sensors  could  be  profitably  used  to  improve 
the  accuracy  of  the  control  of  micro-motions  of  manipulated  objects  or  tools,  especially  in 
the  presence  of  slipping  and/or  rolling  contacts. 
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Appendix  1. 


The  contact  centroid  general  property  (Proposition  1)  given  in  section  2.1  u'U  be  proved 
in  three  steps,  where  properties  of  increasing  generality  are  illustrated: 

Property  1:  If  a  distribution  A  of  compressive  contact  tractions  v(r),  acts  on  a 
set  of  contact  points  C  =  {rc}  of  a  planar  surface  P{ r)  =  0.  the  contact  centroid 
of  A  on  P  lies  inside  the  convex  hull  enclosing  every  point  rc  (see  figure  9). 


Figure  9:  Contact  on  a  planar  surface. 


Proof:  Consider  a  line  p  in  the  contact  plane  P  passing  through  at  least  one 
contact  point  rc  and  leaving  all  others  on  the  same  half  plane,  as  depicted  in 
figure  9.  By  definition  1,  a  set  of  forces  equivalent  to  the  given  contact  set  is 
comprised  of  a  resultant  force  p  =  fp  v(r)  applied  at  the  contact  centroid,  and  a 
torque  q  normal  to  the  contact  plane.  In  order  to  satisfy  the  balance  of  moments 
about  the  line  p,  the  contact  centroid  must  lie  on  the  same  half  plane  where  the 
contact  points  do.  Considering  the  family  of  all  such  lines  p ,  the  convex  hull 
results  as  the  envelope  of  the  family,  and  the  proposition  follows. 
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In  other  words,  for  a  planar  sensor  with  compressive  forces,  no  matter  how  far  away 
the  contact  points  are  from  each  other,  the  contact  can  be  considered  'soft  finger",  and  the 
contact  centroid  lies  inside  the  smallest  convex  polygonal  line  enclosing  every  contact  point. 

Property  2:  Consider  a  convex  surface  S( r)  =  0  (see  figure  10),  and  a  plane 
P(r)  =  0  intersecting  5'.  Let  n'  be  the  norma)  unit  vector  to  P.  pointing  at  the 
half  space  where  P( r)  >  0).  Assume  that  a  distribution  A  of  contact  tractions 
v(r)  is  exerted  on  a  set  C  of  points  r,.  lying  on  P  and  internal  to  5  ,  and  assume 
that  the  tractions  are  compressive  with  respect  to  n'  (i.e.,  n'Tv(rc)  <  0,  for  all 
rc).  In  these  hypotheses,  the  contact  centroid  of  A  on  5  lies  in  the  half  space 
P{r)  >  0. 

Proof:  Because  of  the  first  property  of  contact  centroids,  the  distribution  A  of 
contact  forces  applied  on  C  is  equivalent  to  its  resultant  force  p  applied  to  a 
contact  centroid  c'  on  P ,  and  torque  q',  such  that  c'  is  inside  5  and  q'  is  parallel 
to  n'.  We  denote  with  c,  n  and  q  the  contact  centroid  of  A  on  5.  the  associated 
normal,  and  the  local  torque,  respectively.  Let  moreover  e  =  c  —  c'.  The  balance 
of  moments  about  c'  can  then  be  written  as 

q'  =  q  +  exp,  (18) 

* 

which  can  be  rewritten  as: 


£'n'  =  £n  +  e  x  p,  (19) 

where  £  and  £'  are  scalar  constants.  By  multiplying  both  members  of  equation  19 
by  pr,  and  by  er,  we  obtain  two  equations: 


£'pTn'  =  £pTn,  (20) 

£'ern'  =  £eTn,  (2i) 

For  the  hypotheses  above  and  for  the  definition  of  contact  centroid.  prn'  <  0 
and  pTn  <  0  (compressive  contact).  lienee,  from  equation  20.  f  and  must 
have  the  same  sign  or  be  both  zero. 

If  £  and  are  not  null  and  have  the  same  sign,  from  equation  21  follows  that  also 
e7n'  and  eTn  have  the  same  sign.  Since  5  is  convex  and  c'  is  inside  5,  ern  >  0 

for  every  e.  Therefore,  ern'  >  0,  that  is  e  points  to  the  half  space  P(r)  >  0  as 

required. 
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Figure  10:  Contact  on  a  deformable  surface. 

Otherwise,  if  both  £  and  are  zero,  than  from  equation  19  follows  that  e  and  p 
must  be  parallel.  Let  then  e  =  Cp;  using  again  the  fact  that  prn  <  0  (definition 
of  contact  centroid)  and  that  eTn  =  £prn  >  0  (convexity  of  5),  we  have  that 
C  <  0.  Since  also  c'  is  a  contact  centroid,  pTn'  <  0.  Finally  we  have  then 
eTn'  =  £pTn'  >  0,  q.e.d.. 

Rephrased,  this  second  property  has  intuitive  meaning.  Consider  a  sensor  with  convex, 
compliant  surface  which  is  deformed  by  contact  with  a  flat  object:  no  adhesive  forces  are 
exerted,  and  the  deformed  surface  stays  inside  the  undeformed  one.  Since  the  deformed 
surface  is  not  known,  the  contact  centroid  can  only  be  calculated  relative  to  the  sensor 
undeformed  surface.  However,  the  contact  centroid  is  well  behaved,  in  the  sense  that  it  will 
stay  on  the  same  side  of  the  areas  being  touched  (see  figure  10). 

Property  3:  Consider  a  deformable  body,  whose  undeformed  surface  5(r)  =  0 
is  convex,  and  assume  that  a  distribution  A  of  compressive  contact  tractions  is 
exerted  on  a  set  of  contact  points  C  =  {rc}  of  5.  Consider  a  plane  P(r)  =  0  that 
divides  the  surface  of  the  deformed  body  in  two  portions,  so  that  everv  contact 
point  is  confined  in  one  half-space  (see  figure  2).  Consider  the  projection  of  each 
contact  point  rc  on  P  along  the  direction  of  the  traction  applied  at  rc:  if  all  such 
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projections  lie  inside  the  undeformed  surface  S.  then  the  contact  centroid  on  5 
of  A  lies  on  the  same  side  of  P  where  A  is  applied. 

Proof:  Since  pure  forces  or  tractions  can  be  moved  along  their  line  of  application 
without  affecting  the  resultant  force  and  torque  of  the  set.  this  proposition  is 
easily  derived  from  property  2. 

In  order  to  give  the  best  estimate  of  the  location  of  contact  points,  the  plane  P  can  be 
chosen  as  the  one  that  separates  the  smallest  portion  of  5  enclosing  every  contact  point/ area: 
if  some  contact  points  belong  to  P,  it  is  required  that  the  contact  traction  at  those  points 
be  strictly  compressive  with  respect  to  the  plane. 


Appendix  2. 


Proposition  2:  Uniqueness  of  Solutions 

A  solution  to  the  contact  sensing  problem,  described  by  equations  1  through  4 
and  by  the  definition  of  contact  centroid,  is  unique  (if  it  exists),  if  and  only  if  the 
surface  is  convex. 

Proof:  The  “if”  part  of  the  proposition  can  be  demonstrated  by  contradiction: 
assume  that  there  are  two  points,  c  and  c'  (expressed  in  an  arbitrary  reference 
frame  B )  lying  on  a  convex  surface  S',  that  are  solutions  of  the  contact  sensing 
problem,  and  consider  the  vector  e  =  c'  —  c  (see  figure  11).  Because  of  the  surface 
convexity  we  have  that: 


eTn'  >  0, 

eTn  <  0.  (22) 

The  balance  of  moments  at  point  c  can  be  written  as 

q  =  q'  +  e  x  p, 

Since  q  and  q'  are  parallel  to  n  and  n'  respectively,  we  can  rewrite 

£n  =  £'n'  -(-exp,  (23) 
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Figure  11:  The  contact  centroid  on  a  convex  surface  is  unique. 


and,  by  multiplying  both  terms  by  pr,  we  have 


£PTn  =  rpTn', 

which,  since  forces  are  assumed  compressive,  implies  that  either  (('  >  0  or  f  = 
=  0. 

If  £  =  £'  =  0,  no  local  torques  are  exerted  at  c  nor  at  c',  and  those  points  lie  on  a 
line  parallel  to  p.  Because  of  the  convexity  of  S,  only  one  of  the  two  intersections 
of  such  line  can  satisfy  the  definition  of  contact  centroid  (pTn  <  0). 

If  ££'  >  0,  by  multiplying  both  terms  of  equation  23  by  eT,  we  obtain 

n  =  {e  n  , 


that,  together  with  the  convexity  condition  22,  implies  either  <  0  (a  contra¬ 
diction),  or  e  =  0,  the  proposition.  In  addition,  it  can  be  easily  shown  that  the 
uniqueness  of  the  contact,  centroid  holds  also  if  the  surface  is  planar,  provided 
that  the  contact  tractions  are  strictly  compressive. 
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To  demonstrate  the  “only  if”  part,  suppose  the  surface  is  not  convex;  that  is. 
there  exist  two  distinct  points  such  that 

eTn'  <  0. 

ern  <  0.  (24) 


Thus  a  compressive  force  in  the  direction  of  e 
identical  sets  of  forces  and  moments.  Hence  the 
statement  is  proved. 


applied  at  either  point  yields 
solution  is  not  unique  and  the 
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